#ifndef __CONTROL_H
#define __CONTROL_H

#include "include.h"
#include "motor.h"
#include "math.h"
#include "string.h"
void MotionCtrl(void);
void PID_Init(void);
void PID_Calculate(PID_Object *PID,int16_t Target,int16_t Fb);
#endif

